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H ' The existing attitude controllers (without angular velocity measurements) involve explicitly the 

orientation (e.g., the unit-quaternion) in the feedback. Unfortunately, there does not exist any sensor that 
r^^ ', directly measures the orientation of a rigid body, and hence, the attitude must be reconstructed using a 

set of inertial vector measurements as well as the angular velocity (which is assumed to be unavailable in 
velocity-free control schemes). To overcome this circular reasoning-liks problem, we propose a velocity- 
free attitude stabilization control scheme relying solely on inertial vector measurements. The originality 
of this control strategy stems from the fact that the reconstruction of the attitude as well as the angular 
velocity measurements are not required at all. Moreover, as a byproduct of our design approach, the 
proposed controller does not lead to the unwinding phenomenon encountered in unit-quaternion based 
attitude controllers. 



I. Introduction 



(3 . The attitude control problem of rigid bodies has been widely studied over the last decades. The 



interest devoted to this problem is motivated by its technical challenges as well as its practical 
implications in many areas such aerospace and marine engineering. The main technical difficulty 
encountered in this type of mechanical systems may be attributed to the fact that the orientation 
(angular position) of the rigid body is not a straightforward integration of the angular velocity. 
Several interesting solutions to the attitude control problem have been proposed in the literature 
(see, for instance, M, [El, ^, 11251). 
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As it is customary in the position control of mechanical systems, the majority of the control 
schemes developed for rigid bodies are (roughly speaking) of Proportional-Derivative (PD) type, 
where the proportional action is in terms of the orientation and the derivative action (generating 
the necessary damping) is in terms of the angular velocity. The requirement of the angular 
velocity can be removed through an appropriate design, usually based on the passivity properties 
of the system, as done in 01, [H, W, ^, ^ and [|24l, for instance. Since there is no 
sensor that directly measures the orientation, the explicit use of the attitude (e.g., the unit- 
quatemion) in the control law calls for the development of suitable attitude estimation algorithms 
that reconstruct the attitude from the measurements provided by some appropriate sensors (such 
as inertial measurements units (IMUs)). Therefore, the integration of the attitude estimation 
algorithm with the attitude controller has to be taken with extra care as the separation principle 
does not generally hold for non-linear systems. 

Initially, the attitude determination from vector observations, has been tackled as a static 
optimization problem for which several solutions, based on Wahba's problem, have been proposed 
|[T9l. These algorithms have been refined, later on, incorporating filtering techniques of Kalman- 
type to handle the measurement noise (see, for instance, [|3l, [|20ll and the survey paper [5J). On 
the other hand, probably the most simple and yet practical dynamic attitude estimation approach 
is the linear complementary filtering (see, for instance, [|23l ). where the angular velocity and 
the inertial vector measurements are fused (via some appropriate linear filters) to recover the 
orientation of the rigid body for small angular movements. This approach has been extended to 
nonlinear complementary filtering for the attitude estimation from vector measurements in [|7J, 

m, Ea, ma, m. 

In fact, the existing dynamic estimation algorithms (involving signals filtering) make use of 
the angular velocity information to reconstruct the orientation of the rigid body. Therefore, a 
natural question that may arise is whether it makes sense to use velocity-free attitude controllers 
such as those proposed, for instance, in [fTTI . [|22l and [|24l . since the angular velocity will be 
used (anyways) to recover the attitude via dynamic estimation algorithms. In this context, the 
main contribution of the present paper, is the development of a new attitude stabilization control 
scheme that uses explicitly inertial vector measurements without requiring (either directly or 
indirectly) the velocity measurement. This controller is a true velocity-free scheme since neither 
the angular velocity nor the orientation are used in the control law. Moreover, as it will be shown 



later, the unwinding phenomenoiu (inherent to the quaternion representation) is avoided in our 
approach. 

II. Rigid-body attitude representation and equations of motion 

The attitude (orientation) of a rigid body can be represented in several ways, among which, 
one can recall the rotation matrix R evolving in the special orthogonal group of degree three, 

50(3) = {Re W^""'^ I R^R = RR^ = h, det{R) = 1}, 

where I3 is a 3-by-3 identity matrix. Another globally non-singular representation of the attitude 
consists of using four-dimensional vectors Q, called unit-quaternion, evolving in the three-sphere 
§3, embedded in R^ S^ = {Q G R^ | Q^Q = 1}. 

A unit-quatemion Q = (qq, q^Y i^ composed of a scalar component go ^ J^ and a vector 
component g G M^, such that q^ + q^q = 1. A rotation matrix R describing a rotation by an 
angle about the unit-vector k G M?, can be represented by the unit-quatemion Q or —Q such 
that go = cos(6'/2) and g = sin(6'/2)A;. Note that the mapping from 50(3) to S'^ is not a one-to- 
one mapping as there are two unit quaternion that represent the rotation matrix R. The rotation 
matrix R (that describes the orientation of the body-attached frame with respect to the inertial 
frame) is related to the unit-quatemion Q = (go, q'^)^ through the Rodriguez formula R = TZ{Q) 
(see, for instance, flSl, lITSl ). The mapping 7^ : §^ — )■ 50(3) is given by 

n{Q) = /3 + 2go5(g) + 25(g)2 = (g2-g^g)/3 + 2gg^ + 2go5(g), (D 

where 5 : M^ ^ so (3), such that 

— X3 X2 
S{x) = X3 -xi 
—X2 xi 

with X = [a:i,a:2,a:3]'^ G M^ and 5o(3) = {S e R^""^ \ 5^ = -S} is the set of 3-by-3 
skew symmetric matrices. Given a rotation matrix R and two vectors x,y G M'^, we have the 
following useful properties: S{x)y = —S{y)x = x x y, S{x)x = 0, S{x)S{y) = yx'^ — {x'^y)!^ 

'Using the unit-quatemion representation, the same attitude can be represented by two different unit-quatemion, namely Q 
and — Q. This fact, often leads to the so-called unwinding phenomenon, which is undesirable since some closed-loop trajectories, 
for some initial conditions close to the desired attitude equilibrium, can undergo an unnecessary homoclinic-like orbit ID. (21. 



and S{Rx) = RS{x)R'^, where x denotes the vector cross product. 

The three-sphere (where the unit-quaternion evolve) has a natural Lie group structure given by 
the quaternion multiplication (which is distributive and associative but not commutative) denoted 
by "0". The multiplication of two quaternion P = {po,P^)^ and Q = {qo,q^)^ is defined as 



PQQ 



(2) 



Poqo - p^q 

Poq + qoP + py- q 

and has the quaternion (1, 0|f )^ as the identity element. Given a unit-quaternion Q = (go, q'^)^, 
we have Q Q^^ = Q^^ Q Q = (l,0!f)^, where Q^^ = (go, —q^Y ^^^^ O3 i^ 3-dimensional 
zero vector. 

Throughout this paper, x := (0,x^)^ will denote the quatemion associated to the three- 
dimensional vector X. A vector xj expressed in the inertial frame X can be expressed in the 
body frame Bhy x^ = R^xx or equivalently in terms of unit-quaternion as xq = Q^^ Qxx&Q, 
where xx = {0,Xx)'^, xs = {0,x'^)^, and Q is the unit-quatemion associated to R as per ([T]). 
The rigid body attitude kinematics, in terms of the rotation matrix, are given by i? = RS{uj), 
and, in terms of the unit-quatemion, by 



Q:-- 



qo 
q 



2^0^ 



1 T 



Uqoh + S{q))u 



(3) 



with u being the angular velocity of the rigid body expressed in the body-attached frame B. 
The rigid body rotational dynamics are governed by 

Juj = r-S{uj)Juj, (4) 

were J E M'^^'^ is a symmetric positive definite constant inertia matrix of rigid body with respect 
to the body attached frame B, and r is the extemal torque applied to the system expressed in B. 



in. Problem Statement 

We assume that the rigid body is equipped with at least two inertial sensors that provide 
measurements (in the body-attached frame) of constant and known inertial vectors r^ G M'^, 
i = 1, . . . ,n > 2, satisfying the following assumption: 

Assumption 1: At least two vectors, among the n inertial vectors, are not coUinear. 

The vector measurements in the body-attached frame are denoted by bi E M^, i = 1, . . . ,n. 
The vectors r^ and bi are related by bi = R^Vi. We assume that the angular velocity cu of 



rigid body as well as the attitude (Q or R) are unknown (unavailable for feedback). The only 
variables available for feedback are the inertial vector measurements. Our objective is to design 
a control input r (using only the vector measurements) guaranteeing almost global asymptotic 
stability of the equilibrium points characterized by (go = ±l,g = 0,a; = 0) or, equivalently, 
(R = Li,uj = 0). Since the motion on 50(3) (which is not a contractible space), is hampered 
by some well known topological obstructions that preclude global asymptotic stability results 
via time-invariant continuous state feedback (see, for instance, |[T|, [TTOl ). the notion of almost 
global asymptotic stability is commonly used in this context and is defined as follows: 

Definition 1: An equilibrium point x* of a dynamical system is said to be almost globally 
asymptotically stable if it is stable and all the trajectories starting in some open dense subset of 
the state space converge to x*. 

IV. Main results 
A. Preliminary results 

Let us define the following dynamic auxiliary system: 

Q = Iq&^, (5) 

with an arbitrary initial condition Q{0) E S^, where (3 := (0, /3^)^ with (3 being a design variable 

to be defined later in Theorem 1. 

Let us define the vectors bi, i = 1, . . . ,n, as bi = TZ{Q)'^ri or, equivalently, bi = Q^^ &ri& Q, 

corresponding to the vector r, in the frame attached to the auxiliary system (|5]). 

Let R := TZ{Q) = TZ{Q)TZ{Q)^ denote the discrepancy between the actual rigid-body orientation 

and the orientation of the auxiliary system dD, which corresponds to the unit quaternion error 

Q '■= i%, Q^Y = Q & Q ^ whose dynamics is governed by 



Q = iQQu 



1 ~T ~ 



^l X 



{qoh + S{q))uj 



(6) 



where a) = Tl{Q){uj — /3). 

In the sequel, for the sake of simplicity, the arguments associated to the rotation matrices will 
be omitted. It is understood that R, R and R correspond, respectively, to the rotation matrices 
TZ{Q), Tl{Q) and TZ{Q), associated, respectively, to the unit quaternion Q, Q and Q. 



Before stating our main results, let us define the following variables: z^ := Yl^=i liS{hi)hi, 
^P ■■= Eti P^S{r^)b„ W, := -Etil^S{r,f and W, := -E^=lP^S{r^)^ where 7, > and 
Pi > for i = 1, . . . ,n, and let us state the following useful Lemmas: 
Lemma 1: The following equalities hold: 

z^ = -2Ff{qoI-Siq))W^q, (7) 

Zp = -2{qoI - S{q))Wpq, (8) 

Proof: Using the facts that bi = R^ri, hi = R^Vi and S{R^ri) = WS{ri)R, we have 

n n 

z, := J2^.S{k)k = lfJ2^^S{r,)R^r,. (9) 

1=1 i=l 

Rewriting R in terms of the unit-quaternion Q, i.e., R = TZ{Q), and using the facts that S{ri)ri = 
and S{q)ri = —S{ri)q, one gets 

n 

z^ = 2lf Y, l^S{n){qf - qoS{q))n = -2Ff{S{q)M^ + qoW^)q, (10) 

j=i 

where M^ = Yll=i li^i''"!- One can also show that M^ = pl^—W-y, /i = J2'i=i li^I'^i- Substituting 

the expression of Af^ in (flOl) . yields (|7]). Similar steps can be used to obtain Zp. ■ 

Lemma 2: Under Assumption [T] the matrices W^ and Wp are positive definite. 

Proof: For any y G M'^ we have 

-y ^[rt)y = y [r^ri)y-y r^r^ y = ||r,|| \\y\\ - [y Ti) > 0, 

which shows that —S{riY > 0. Now, without loss of generality, assuming that ri and r2 are the 
two non-coUinear vectors, one has 

y'^W.y = -/ [ X^ l^S{n)A y = -WS{n)'y - i2y^S{r2fy + /Sy, (11) 

where S = — ^"=3 7i>S'(rj)^ > 0. It is clear that y'^S{riYy = is equivalent to S{ri)y = 
Ti X y = 0, which is satisfied, for some y 7^ 0, if and only if y and ri are coUinear. Similarly, 
for y ^ 0, y'^S{r2f'y = if and only if y and r2 are coUinear. Since ri and r2 are non-coUinear, 
they cannot be both coUinear to the same y, and hence, — 7iy^5'(ri)^y — 72y^>S'(r2)^y > for 
all y 7^ 0. Consequently, from (fTT)) . one can conclude that y^W^y > for all y ^ 0, which ends 
the proof. ■ 

Lemma 3: Under Assumption \T\ the following statements hold: 



i) z^ = is equivalent to (go = 0,g = v^) or {% = ±l,g = 0), were v^ are the unit 

eigenvectors of W^. 
ii) Zp = is equivalent to (go = 0,g = Vp) or (go = ±l,g = 0), were Vp are the unit 
eigenvectors of Wp. 
Proof: Using Lemma 1, 2;^ = is equivalent to 

(go/ - S{q))W,q = 0, (12) 

from which one can see that (go = ±1, g = 0) is a trivial solution. The other solutions can be 
obtained by assuming g 7^ and multiplying (fT2l) by q^ to obtain %q^W^q = 0, which shows 
that go = is a solution since W^ is positive definite (as per Lemma 2). Now, we need to find 
the values of g for which go = 0. Using (fT2)) with go = 0, we obtain S{q)W^q = 0. Since W^ is 
non-singular, the last equality is satisfied if and only if W^q = \q for some constant scalar A, 
which shows that q = v^, where v-y are the unit eigenvectors of W^. Similar steps can be used 
to prove (ii) and hence omitted here. This completes the proof. ■ 

Remark 1: It worth pointing out that the unit-eigenvectors of W^ are also the unit-eigenvectors 
of M^ = Yl'i=i li'^i'^I ■ This can be easily deduced from the fact that M^ = yu/3 — W.y, with 
/i = Yll=i li^I^i- Likewise, the unit-eigenvectors of Wp are also the unit-eigenvectors of Mp = 
Sr=i Pi'^i'^I ■ Note also that the eigenvalues of W^ (resp. Wp) can be arbitrarily increased by 
increasing the gains 7j (resp. pi). 

B. Vector measurements based attitude stabilization 
We propose the following control law: 

T = Z^ + Zp, (13) 

where z^ and Zp are defined in subsection IV-A, and the following input for the auxiliary system 

©: 

/3 = -z,. (14) 

Under the proposed control law, the closed loop dynamics are given by 

q = l{qoh + S{q))R{u + z^) 

q = l{qoh + Siq))co (15) 

Juj = —S{uj)Juj + z^ + Zp, 



where R := n{Q) = n{Qfn{Q), and z^ = -2n{Qfn{Q){qoI - S{q))W^q and Zp = 
—2 (go/ — S{q))Wpq. Note that the scalar parts of Q and Q that appear in (fT5l) are related to the 
vector parts as follows: ^q = 1 — q^q and ^q = 1 — q'^q. It is clear that the closed loop dynamics 
(fT5l) are autonomous. 

Let X '■= (q^Q^^)^ be the state vector belonging to the state space T := D x D x M'^, with 
Z^:={xgM^| ||x||<1}. Now, one can state our first theorem. 

Theorem 1: Consider system ©-(H]) under the control law (fUt . Let (IT4]) be the input of ([5]). 
Assume that n vector measurements 6j, corresponding to the inertial vectors ri, i = 1, . . . ,n >2 
are available, and Assumption [T] holds. Then, 

1) The equilibria of the closed-loop system (fTST ) are given byB fii = (0, 0, 0), 1^2 = {v^, 0, 0), 
^3 = (f^, Vp, 0) and ^^4 = (0, Vp, 0), where v^ and Vp are, respectively, the unit eigenvectors 
of W^ and Wp. 

2) The equilibrium point fii is asymptotically stable with the domain of attraction containing 
the following domaiiu: 

<^i = {xeT\ x^Px < c} , 

where P = diag{2Wy,2Wp,^J), c < 2mm{X^in{W^), Xmin{Wp)} and Xmini-^) is the 
minimum eigenvalue of (i^). 

3) There exist kp > and A;^ > such that if XmmiWp) > kp and Xmin{Wy) > k^, then Q2, 
^3 and ^^4 are unstable, and Qi is almost globally asymptotically stable. 

Proof: Consider the positive definite, radially unbounded, function V : T —^ R>o such that 

V{q, g, 00) = 2fW^q + 2q^Wpq + -u^Ju, (16) 

where W^ = W^ > 0, Wj = Wp > are defined in subsection IV-A. Using © and the 

n 

properties of the skew symmetric matrix and the unit-quaternion, one can show that 2_. iM^i = 

i=l 

^Note that ^2 is not a single equilibrium point as we have multiple values for v~i (unit eigenvectors of VK-y). The same remark 
goes for f^a and SI4. 

'Note that the domain of attraction $1 includes the domain $1 := {x £ T | ||g|p + ||(7|p + ^'^°^(J) ||t^||2 ^ ^}, 
with Am = 2min{\min{W^),\min{Wp)}, Xm = 2inax{Xr„ax{W^f),\max{Wp)}, where Xmaxi*) denotes the maximum 
eigenvalue of (•). If the control gains are sufficiently large such that Xm ^ Xmax{J), the domain "I>i approaches {x £ 
r\\\qf + \\qf<^}. 



n 



Aq W^q and y.Pi'^i ^i = M ^pQ^ where bi := bi — h and Cj := ri — bi. One can also show 

that the dynamics of bi and e, are governed by 

h = S{h){li - uj) + S{h)u: 
Ci = -S{bi)u, 

where we used the fact that R = RS{uj) and R = RS{f3). 
Consequently, one can rewrite (fT6] ) as follows: 



(17) 



1 " ~ 1 " 1 

whose time-derivative, along the trajectories of dU and (fTTI) . is given by 

n n 

*1^^ ^ ^1:^ (19) 

= ^ 'jibJS{bi){/3 -u) -^ pirJS{bi)u + a;^r = (/3 - a;)^^;^ - a;'^2;p + uFt, 

i=l i=l 

which, in view of (fT3] ) and (fT4l) . yields 

V = -z^^z^ = -^^W:;{h - qf)W,q, (20) 

were we used Lemma 1 and the properties of the unit-quaternion and the skew- symmetric matrix 
to obtain the second equality. Since the closed-loop dynamics (g, q, to) are autonomous, we 
proceed with LaSalle's invariance theorem. From (l20T i. setting V = leads to 2;^ = 0, which 
in view of Lemma 3, implies that Q = (±1, Of^)^ or Q = (0, f^)"^. Since Q is constant, one 
can conclude from (|6]) that cu — (3 = 0. Since z^ = 0, it follows from ([14] ) that (3 = 0, and 
consequently tu = since tu = (3. Since tu = 0, from dH), it follows that r = 0. Using this last 
fact, together with the fact that z^ = 0, one can conclude from (fT3l) that z^ = 0. Again, invoking 
Lemma 3, one has Q = (±1, 0^)^, or Q = (0, f J)^. It is clear that the largest invariant set in 
T, for the closed loop system, characterized by V = is given by Vlinv = Ui=i ^«- 
Since we showed that V < 0, one has F(x(t)) < V{x{0)), for all t > 0, which shows that $1 is 
a positively invariant sublevel set. Since V{x) > 2Amm(W^7)||'?|P and V{x) ^ 2Amm(VFp)||q'|p, 
it is clear that min V{x) = 2mm{XminiWj), XminiWp)}. Consequently, $1 C {x G 
T I ||g|| < 1 , ||g|| < 1}. Therefore, ^2^ ^3 and ^^4 do not belong to $1. Finally, since the 
largest invariant set in $1, corresponding to V = 0, is nothing else but ili, the second claim of 



the theorem is proved. 

Now, we need to show that ^22, i^3 and 1^4 are unstable. First, let us focus our attention on 
0.2 and 1)3 that belong to the manifold characterized by (go = 0,a; = 0). In fact, the closed 
loop dynamics of go are given by go = {Q^W^q)qo — \q^Ruj, which can be written, around 
(go = 0,0; = 0), as follows: 



1 



go = ^7^0- 2^7^^' (21) 

where r]^ := v'^W^v^. Consider the following positive definite function: Vo(go) = |go» whose 
time derivative along the trajectories of (1211 is given by 



Since go and u are bounded (as per (1161 ) and (|20l )). and go = is not an invariant manifold, it 
is clear that, in the neighborhood of (go = 0, cj = 0), there exists a finite parameter A;^ > such 
that I II a; II < A;^|go|. Consequently, one has Vq > (^7 — ^7) go- Since r/^ is an eigenvalue of W-y, 
Vj ^ ^miniWj) > 0. Hence, Vq > as long as XminiW^) > k^ and go 7^ 0, which shows that 
VL2 and ^3 are unstable. 

Now, let us show that ^4 is unstable, using Chetaev argument^. To this end, we will show 
the instability of the manifold characterized by (go = 0,a; = 0). Let us define 5 := q^Jcu, and 
consider the dynamics of go and S in the neighborhood of ^^4 



go = -2%^ 



(23) 

5 = -2r]pqo, 



where r]p = v^WpVp. Let us consider the following Chetaev function: V{qo,S) = —qoS. Define 
the set Br = {x := (go, 5) E [—1 , 1] x M | ||x(t)|| < r} where < r < 1. Let us also define a 
subset of Br where V > 0, that is, Ur = {x E Br \ V{x) > 0}. Note that Ur is non-empty for 
all < r < 1, and V(0, 0) = 0. The time derivative of V, in view of (|23l) . is given by 

V = 2r^pql + '^Svjco > i2vp - '^kfk'^)ql (24) 

where we used the fact that \S\ < kf\\uj\\, with || J|| = kf, and the fact that, around the manifold 
characterized by (go = 0,uj = 0), with go 7^ 0, there exists a positive parameter kg such 
that ||a;|| < A;g|go|. Since rjp is an eigenvalue of Wp, rjp > XminiWp) > 0. Therefore, picking 

''The reader is referred to ^ for more details about Chetaev Theorem. 



Amm(W^p) > jkfk'^ =: kp, it follows that V" > for all go ¥" 0- 

Picking the initial conditions a;(0) G Ur, x{t) must leave Ur since V{x) is bounded on [/,. and 
V{x) > everywhere in U.,.. Since V{x(t)) > V{x(0)), x{t) must leave [/,. through the circle 
||a;|| = r and not through the edges V{x) = (i.e., 5 = or % = 0). Since this can happen for 
arbitrarily small r, the equilibrium (go = 0,5 = 0) is unstable and so is ^4. 
Finally, since the possible stable manifolds associated with the unstable equilibria belong to a 
set of Lebesgue measure zero in the state space, it is clear that r2i is almost globally attractive. 

■ 
Remark 2: For the sake of simplicity, the desired attitude has been taken as I3. However, it 
is straightforward to extend the proposed control law to the case of an arbitrary constant desired 
attitude Rd = Tl{Qd) by taking Zp = Yl'i=iPiSiRdri)bi- 

C. Attitude stabilization using preconditioned vector measurements 

In this section, we will show almost global asymptotic stability of the desired equilibrium 
point without any conditions on the minimum eigenvalues of Wy and Wp. This results are made 
possible through an appropriate preconditioning of the inertial measurement vectors. 
Let us assume that we have only two vector measurements 61,62 G ^^ corresponding, respec- 
tively, to two inertial vectors ri,r2 G M^ (which are assumed non-coUinear). Let us define the 
normalized (unit) vectors Vi = jP-u, V2 = J"^T'^u and V3 = u/^\^^^w It is clear that if 1, f2, fsj 
forms a unit orthonormal basis. Let us define ui = ipV, U2 = ii^^^^^n and M3 = n) ^^ ^{^ \| . Using 

\\i"i\\ ||'"ixr2|| ^ ||(ri xr2)xri]| o 

the fact that 61 = R^ri and 62 = R^i"2, one can easily show that Ui = R^Vi, for i G {1, 2, 3}. Let 
us define z^ := 7 ELi '^'(Mi)^*, Zp := p ELi '^'(^i)^*, Ui = Tl{QYvi, W^ := -7ZIL1 'S'(^i)^ 
and Wp := -pELi S{v^f, with 7 > 0, p > 0. 

The choice of t>i, t>2 and ^3 leads to W^ = 27/3 and Wp = 2p/3. This can be shown as 
follows: Since {fi,f2,f3} is a unit orthonormal basis, one has M^ := lYlii=i'^i'^I = 7-^3 since 
MyVi = 7f j, i = 1,2, 3. Furthermore, since W^ = p/3 — M^ with p. = 7 Yl^=i ''^I''^i = ^7, it is 
clear that W^ = 27/3. 
In this case, using Lemma 1 and the new values of W^ and Wp, it follows that 

Zy = -AjR^qoq, Zp = -^ipq^q. (25) 

Now, one can state our second theorem: 



Theorem 2: Consider system ©-(HI) under the control law (fUt and the input of the auxiliary 
system ([5]) given in (fT4l) . with 2;^ and z^, as defined in subsection IV-C. Then, 

1) The equilibria of the closed-loop system are given by \l'i = (0,0,0), '^2 = {(1 ^ S^7 0,0), 
^3 = (g G §2, q E S^, 0) and ^4 = (0, g G S^, 0). 

2) The equilibria \E'2, ^E's and \E'4 are unstable, and \l'i is almost globally asymptotically stable. 
Proof: As in the proof of Theorem 1, one can show that the closed-loop system is au- 
tonomous. Consider the positive definite function (fT6] ) which, due to the fact that W^ = 27/3 
and Wp = 2 pis, can be written as 



V{q,q,uj) 



1 I f ^ ^ \ 

i'jq^q + Apq^q + -u'^ Ju = ij^il^ ujui + p ^ ef e^ + u^Ju\ , (26) 



where Ui := Ui — Ui and Cj := fj — Ui. Using the fact that Ui = S{ui){[5 — uj) + S{ui)uj and 
Cj = —S{ui)uj, the time derivative of (1261 ). along the closed-loop system trajectories, is given by 

V = -z^z^ = -lQi^f{h - qf)q = -167lg|r(l - ||gf ), (27) 

which vanishes at g = or ||g|| = 1. Similar steps as in the proof of Theorem 1, in view of 
(l25l) . can be applied to conclude that the largest invariant set in T, characterized by V^ = 0, 
is given by "^im, = Ui=i ^j- Again, as in the proof of Theorem 1, one can show that the 
equilibrium ^1 is asymptotically stable with the domain of attraction containing the domain 
$2 = {x e T I x^Px < 4min{7,p}} C {x G T | ||g|| < 1 , ||g|| < 1}. 

Now, we need to show that \1'2, ^3 and \1'4 are unstable. In fact, at the equilibria characterized 
by ^2, the Lyapunov function becomes V^2 = 47t>^t> = 47, where v is an arbitrary vector living 
in the unit 2-sphere S^. A small disturbance e E D acting on v, in the neighborhood of ^2, 
i.e., q = V + t, such that < ||g|| < 1, would lead to V = 47||g||^ < 47 = V^2- Since V is 
non-increasing, it is clear that \1'2 is unstable. Similar arguments can be used to show that \E'3 
and \1'4 are unstable as well, and hence omitted here. Finally, almost global attractivity of ^1 
follows from the previous results and the fact that S^ has Lebesgue measure zero on D. ■ 

Remark 3: The proposed approach guarantees a priori boundedness of the control input, that 
is, ||r|| < Yll=i{li + Pi)lkilP i'^ Theorem 1, and ||r|| < 3(7 + p) in Theorem 2. 

Remark 4: The control law (fTJt can be written as t{Q, Q) = —2R^(qQl — S{q))Wyq — 2(qQl — 
Siq))Wpq, with R := n{Q)^n{Q). Note that t{Q,Q) = t{-Q, ~Q), which confirms the fact 



that the proposed control strategy is not affected by the sign ambiguity of the unit-quaternion 
representation since our approach does not rely on any attitude reconstruction. 

Remark 5: In practical applications involving small scale aerial vehicles, for instance, it is 
customary to equip the vehicle with an IMU composed of accelerometers, magnetometers and 
gyroscopes. The gyroscopes provide the angular velocity to, the magnetometers provide a vector 
measurement of the earth magnetic field in the body attached frame m^, which is related to 
the earth's magnetic field mx expressed in the inertial frame through rfiis = Q"^ rhx Q. 
The accelerometers provide a vector measurement of the apparent acceleration ag in the body 
attached frame, which is related to the acceleration ax expressed in the inertial frame through 
o-B = Q ^ Q ax & Q- In the case of quasi- stationary flights (i.e., \\v\\ <^ g), the acceleration 
expressed in the inertial frame is given by ax = [0, 0, —g]^. The attitude stabilization controllers 
in Theorem 1 and Theorem 2, could be implemented using the vector measurements obtained 
from the IMU (ag, m^), taking ri = ax, hi = a^, r2 = mx and 62 = ""^e- 

V. Simulation Results 

In this section, we present some simulation results showing the effectiveness of the proposed 
approach. The inertia matrix has been taken as J = diag(0.5, 0.5, 1) and the inertial vectors as 
Ti = [0,0, 1]^ and r2 = [1,0, 1]^. The control parameters have been taken as 71 = 72 = 10 
and pi = P2 = 0.5. We performed two simulation tests, using the control law in Theorem 
1, to show the performance of the proposed control scheme and confirm the avoidance of the 
unwinding phenomenon. In the fist simulation test, we considered the following initial conditions: 
uj{0) = [0,0,0]^, g(0) = [0.8,0,0,0.6]^ and Q{0) = [1,0,0,0]^. In the second simulation test, 
we considered the same initial conditions except for Q, where we started the scalar part of 
the unit quaternion from a negative value, i.e., Q{0) = [—0.8,0,0,0.6]^. Figure 1 and Figure 
3 show the evolution of the three components of the angular velocity with respect to time for 
Test 1 and Test 2, respectively. Figure 2 and Figure 4 show the evolution of the unit-quaternion 
with respect to time for Test 1 and Test 2, respectively. We can clearly see that the unwinding 
phenomenon is avoided since both equilibria {qo = l,q = 0,uj = 0) and {qq = —l,q = 0,u = 0) 
are asymptotically stable. 





Fig. ll Test 1: Angular velocity vs. time 



Fig. Z! Test 1: Unit-quaternion vs. time 
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Fig. 3; Test 2: Angular velocity vs. time 



Fig. 4: Test 2: Unit-quaternion vs. time 



VI. Concluding discussion 

It is important to point out that the present work was motivated by the fact that the existing 
attitude control schemes (without angular velocity measurement) use explicitly the orientation of 
the rigid body which is not directly measurable by any means. Therefore, an additional algorithm 
is required for attitude reconstruction (or estimation) using the available measurements (e.g., 
IMU measurements). Reconstructing the attitude from inertial vector measurements via static 
optimization algorithms is often hampered by two problems: 1) Sensitivity to noise; 2) Non- 
robustness due to a memoryless (random) selection among the two possible quaternion solutions 
Q and —Q (which represent exactly the same orientation) as pointed out in ifTSl . On the other 
hand, dynamic attitude estimation algorithms of Kalman-type or complementary-filtering-type 
require the use of the angular velocity measurement. Hence, the integration of such algorithms 



with a velocity-free attitude controller is questionable since the angular velocity is assumed to 
be unavailable. Besides this fundamental circular-reasoning-like problem, the stability of the 
overall system (observer-controller) is not generally guaranteed as the separation principle does 
not generally hold for nonlinear systems. 

Motivated by this facts, we proposed a velocity-free attitude stabilization scheme that does 
not require the orientation reconstruction. To the best of our knowledge, this work is the first 
incorporating directly vector measurements in the design of velocity-free attitude controllers 
without attitude reconstruction. 

The second point that is worth mentioning, is the fact that our control scheme guarantees almost 
global asymptotic stability of the equilibrium points characterized by (go = iljQ" = 0,^ = 0) 
which clearly avoids the well-known unwinding phenomenon (as shown in the simulation results). 
Usually unwinding is generated when the equilibria at go = 1 and go = —1 are not both 
stable, which causes some trajectories, initialized around the unstable equilibrium, to undergo 
an unnecessary motion before joining the stable equilibrium, while both equilibria represent the 
same physical orientation. 
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